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ABSTRACT 

This  article  presents  analysis  of  kinematics  and  dynamics  of  a  serial  manipulator  in  machining  process.  The  kinematic 
and  dynamic  models  of  the  robot  are  derived  and  taken  into  account  the  effects  of  cutting  forces.  The  method  of 
computing  the  driving  torques  of  the  robot’s  joints  to  meet  the  requirements  of  the  form-shaping  motion  of  the  robot  is 
also  presented.  The  results  of  the  analysis  and  computation  are  validated  by  numerical  simulation. 
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1.  INTRODUCTION 


Industrial  robots  have  been  used  in  many  machining  applications  due  to  their  advantages  such  as:  high  flexibility 
having  large  number  of  degrees  of  freedom  that  enables  the  end-effector  of  robots  to  easily  reach  to  desired 
positions  and  orientations  in  the  workspace,  while  processing  complicated  parts.  With  the  different  parts  and 
different  machining  parameters,  the  machining  capability  of  robots  is  implemented  by  the  changeable  machining 
programs. 


Figure  1:  The  ABB  Robot  IRB  7600-500  and  its  Kinematic  Structure  in  Milling  Process. 

However,  there  are  the  challenges  of  using  robots  in  machining  process.  Due  to  the  articulated  chain,  with 
a  large  number  of  degrees  of  freedom,  uncertain  quantities,  it  is  not  easy  to  model  and  compute  the  dynamics  of 
such  robots.  In  addition,  the  low  structure  stiffness,  the  vibration  in  maching  process  affects  accuracy  of  the 
machining  parts.  This  paper  aims  to  cope  with  the  problems  of  modeling  and  computing  of  kinematics,  dynamics, 
design  trajectories  of  robot  in  machining,  in  detail.  Furthermore,  this  paper  determines  the  relationship  of  the 
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driving  torques  and  the  quantities  of  the  robot’s  motion.  The  results  are  applied  to  a  specific  robot  in  milling  process. 

Analysis  the  kinematics  and  dynamics  of  the  robot  need  to  be  dealt  with  carefully.  Firstly,  to  guarantee  the 
parameters  of  machining  process,  both  of  the  relative  pose  and  relative  velocity  of  the  cutter  and  the  workpiece  need  to  be 
met  with  strict  rules.  Secondly,  as  the  motion  of  the  robot’s  links  are  restricted  by  the  kinematic  and  physical  structure 
constraints,  it  is  hard  to  machine  large  and  complicated  parts  while  trying  to  fulfill  all  requirements  of  the  machining 
process.  Thirdly,  it  is  unable  to  calculate  accurately  the  dynamics  of  the  cutting  process,  especially  the  cutting  forces, 
which  act  on  the  cutter.  Fourthly,  precisely  determining  all  of  the  robot  dynamic  parameters  is  a  challenge  because  of  the 
elasticity  of  the  joints  and  links,  which  are  neglected  in  dynamic  modeling.  Fifthly,  the  dynamic  equations  are  complex. 
These  problems  lead  to  difficulties  of  solving  the  kinematic  and  dynamic  equations. 

This  paper  utilizes  the  method  of  transformation  coordinates,  the  homogeneous  transformation  matrices  to 
computing  and  expressing  the  kinematic  and  dynamic  quantities  [1-5].  Lagrangian  dynamic  formulation  is  applied  to 
derive  the  differential  equations  of  motion  [6-10].  The  cutting  forces  are  calculated  by  the  formulas  in  [11-15].  The 
dynamic  parameters  of  the  robot  are  determined  by  using  Autodesk  Inventor  software. 

The  paper  consists  of  five  parts.  Part  1  is  introduction,  part  2  presents  kinematic  analysis,  part  3  designs  the 
trajectories  matching  machining  engineering,  part  4  analyzes  dynamics  of  robot  in  machining  and  part  5  is  the  conclusion. 

2.  KINEMATIC  ANALYSIS  OF  THE  ROBOT  IN  MACHINING  PROCESS 

Figure  1  shows  the  ABB  robot  model  IRB  7600-500  and  the  kinematic  structure  of  the  robot  -  clamping  table  in  milling. 
The  robot  has  6  degrees  of  freedom,  with  a  spindle  and  a  cutter/  tool  attaching  to  the  end  effector.  The  workpiece  is 
clamped  on  the  clamping  table. 

2.1  Determination  of  Tool’s  Pose  Based  on  the  Robot  Kinematic  Chain 

Using  Denavit-Hartenberg  convention  to  assign  the  frames:  OoX0yoZo-  the  base  frame,  O.XiV.z,  -  the  frame  is  attached  to 
the  link  i  (I  =  1,..,6).  0ExEyEzE  -  the  tool  frame  is  attached  to  the  cutter  so  that  Oe  is  coincided  with  the  cutting  point  on  the 
cutter,  xE  is  tangent  to  the  cutting  edge  profile,  zE  is  perpendicular  to  the  cutting  edge  surface,  yE  is  defined  so  as  to 
complete  the  right-hand  rule  frame.  The  position  and  orientation  of  the  frame  0ExEyEzE  with  respect  to  the  frame  06x6y6z6 
is  determined  by  6  parameters  6xE,  6yE,  6zE,  6aE,  6|3E,  6T|e  (the  first  three  parameters  represent  the  position,  the  rest 
parameters  represent  the  orientation  of  the  tool).  Table  1  shows  the  kinematic  parameters  of  the  robot. 


Table  1:  Kinematic  Parameters  of  the  Robot 
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Considering  the  robot  kinematic  chain:  x0y0z0  — >  x , y , z ,  — >  ...  —^  x6y6z6  — >  xEyEzE,  obtained  the  homogeneous 
transformation  matrix  A,  (I  =  1,..,6,  E)  that  represents  the  position  and  orientation  of  link  i  with  respect  to  link  i-1.  As  a 
result,  matrix  is  determined  as  0Aj  that  represents  the  position  and  orientation  of  link  i  with  respect  to  the  base  frame 
OoX0yoZo.  Matrix  °A1E  (1)  represents  the  position  and  orientation  of  the  tool  frame  0ExEyEzE  with  respect  to  the  base  frame 
O0x0yozo.  Vector  q  represents  joint  variables  (2). 
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°a1e  =  °A1(e1)‘A2(e2)...5A6(e6)6AE  d) 

q=[ql,q2,...,q6]T=[01,02,...,06]T  (2) 

2.2  Determination  of  the  Tool’s  Pose  Based  on  Requirements  of  Machining  Engineering 

Odxdydzd  is  the  frame  that  attached  to  the  clamping  table  D,  and  located  to  the  base  frame  00x0yoZo-  The  frame  Odxdydzd  is 
also  called  the  jig  frame.  The  workpiece  is  fixed  on  the  clamping  table,  and  the  shape  of  the  workpiece  is  expressed  in  the 
jig  frame.  Hence,  the  tool  path  or  the  path  that  the  tool  moves  along  the  workpiece’s  surface  is  determined  with  respect  to 
the  jig  frame.  That  is  the  reason  why,  we  need  to  determine  the  positions  and  orientations  of  the  tool  with  respect  to  the  jig 
frame. 


In  this  paper,  the  workpiece  is  located  in  the  jig  frame.  We  express  the  tool’s  pose  with  respect  to  the  jig  frame. 
Vector  p  represents  the  tool’s  pose  with  respect  to  the  jig  frame  Odxdydzd  at  an  milling  instant,  vector  p  is  defined  by  a  set 
of  6  parameters:  (dxE,  yE>  dzE)  are  three  position  parameters,  (daE,  dpE,  drjE)  are  cardan  angles.  Vector  p  is  called  the 
operational  coordinate  vector. 


P  =  [Pl.Pz.-.Pef  =  [dxE,  dyE>  dzE,  daE>  dPE> 

The  tool’s  pose  with  respect  to  the  jig  frame  Odxdydzd  is  represented  by  the  matrix  dAE(p): 
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Table  2  shows  the  parameters  of  the  base  frame,  jig  frame  and  tool  frame  to  determine  the  kinematic  parameters 
of  the  tool’s  pose  with  respect  to  the  base  frame. 


Table  2:  Kinematic  Parameters  of  the  Tool’s  Pose,  Depending  on  Requirements  of  Machining 

Engineering 
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From  the  kinematic  chain  x0y0z0  — >  xdydzd  — >  xEyEzE,  one  can  obtain  the  matrices  °Ad,  dAE,  which  respectively 
represent  the  pose  of  the  jig  frame  with  respect  to  the  base  frame  and  the  tool’s  pose  with  respect  to  the  jig  frame, 
respectively.  The  matrix  nA2E represents  the  tool’s  pose  with  respect  to  the  frame  OoX0y0z0. 
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2.3  Derivation  of  Kinematic  Equations  in  Matrix  Form  of  the  Robot  -  Clamping  Table  System 

The  matrices  °AiEj°A2E  in  (1)  and  (5)  represent  the  tool’s  pose  with  respect  to  the  frame  OoX0yoZo,  equalizing  both  side  of 
(1)  and  (5),  obtained  the  matrix  dAE(p)  that  determines  the  cutter’s  pose  with  respect  to  the  jig  frame  (6): 
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JAE(p)  =  °V°A1(e1)...6AE 
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The  matrix  dAE  of  the  left  side  of  (6)  is  expressed  directly  by  the  operational  coordinates,  denoted  (3),  (4). 
Meanwhile,  in  the  right  side  of  (6),  the  matrix  dAE  is  determined  by  the  joint  variables. 
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The  kinematic  equation  in  matrix  form  (7)  is  used  for  solving  kinematic  problems  of  the  robot  in  machining 

process. 

2.4  Analysis  of  Forward  Kinematics 

The  forward  kinematics  is  used  to  determine  the  tool’s  pose  with  respect  to  the  workpiece,  to  provide  the  data  to  control 
the  end-effector  to  approach  and  carry  out  cutting  processes.  The  joint  variable  vector  q  (qb  q2,...  q6)  and  its  derivative  are 
given  by  sensors,  allow  to  compute  the  parameters  of  the  tool’s  pose  (dxE,  dyE,  dzE,  daE,  dpE,  dqE  )  with  respect  to  the  frame 
O0xdydzd.  The  relative  velocity,  acceleration  of  the  cutting  point  and  the  angular  velocity,  angular  acceleration  with  respect 
to  the  workpiece  are  also  computed  from  (7). 

2.5  Analysis  of  Inverse  Kinematics 

With  respect  to  specific  machining  parts,  the  tool  paths  are  determined  intuitively  and  favorably  with  respect  to  the  jig 
frame.  In  machining  process,  the  tool  moves  along  the  tool  path  on  the  workpiece  by  time,  with  the  position  and  orientation 
of  the  tool  are  determined  by  the  matrix  dAE(p),  with  respect  to  the  workpiece  frame.  Therefore,  the  elements  of  the  matrix 
dAE(p)  are  the  functions  of  time.  The  inverse  kinematic  problem  is  to  determine  the  motion  of  the  robot’s  links  and  the  joint 
variables  in  (7).  According  to  [2,3,4],  from  (7),  we  obtain  (8),  which  has  six  independent  nonlinear  equations: 

=  dxqE (q)- dxE (0  =  °;  f2  =  dyqE(q)-dyE(t)  =  °;  f3  =  dzqE(q)-dzE(t)  =  ° 

l  (o) 

if4  =  cqii(q) -Cpil  (p(t>)  =  0;  f5  =cq22(q)-cp22(P(0)  =  0;  f6  =  Cq33 f q)  - Cp33 (p( t))  =  0 


Where  p  is  the  vector  of  the  tool’s  pose  with  respect  to  the  frame  Odxdydzd,  q  is  the  vector  of  the  joint  variables, 

which  are  defined  by  (2),  (3).  The  six  independent  nonlinear  equations  (8),  with  six  variables  qE  q2, . q6,  are  solved  by 

Newton-Raphson  method. 

From  the  machining  engineering,  the  velocity  and  acceleration  of  the  tool  with  respect  to  the  workpiece,  the 
vectors  of  (3),  (9),  (10)  can  be  determined: 


p  =  [p„p2,...,p6]T  =[dxE,dyE,dzE,daE,d(3E,cliiE]T;  p  =  [ppp2,...,p6]T=[dxE,dyE,dzE,daE,dPE,df|] 


E  J 


(9) 


Derivating  with  respect  to  time  the  equation  (8),  we  get  the  velocity  and  acceleration  of  the  joint  variables: 
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v  =  q  =  [vpv2,...,v6]T  =[qpq2,...,q(i]T  =[61,02,...,0( 


6J 


a=q=[a1,a 


a6]T  =[qPq2,...,q6]T  =[0„  02,...,06]T 


(10) 


3.  DESIGN  TRAJECTORIES  MATCHING  MACHINING  ENGINEERING  REQUIREMENTS 


To  guarantee  the  requirements  of  the  machining  engineering,  the  relative  position,  orientation  and  relative  velocity  of  the 
tool  and  the  workpiece  have  to  match  the  cutting  speed. 


3.1  Design  Geometric  Trajectory 


The  tool  path  on  the  workpiece  is  the  geometric  path  that  the  cutting  point  of  the  tool  moves  along  with  machining  process. 
The  tool  path  is  expressed  by  a  function  of  time  or  a  function  of  dXj,  dyj,  dZj: 


tj  =  dxj(t)>  dyj  =  dyj(t)’  dzj  =  dzj(t)  or  fk(dxj,dyj,dzj)  =  0,  k  =  l,2 


(11) 


The  tool  path  is  also  expressed  by  a  set  of  coordinates  of  points  with  respect  to  the  frame  OdXdydzd,  a  point  has 
three  coordinates  dXj,  dyj,  dZj;  n  is  the  number  of  points,  j  is  the  index,  j  =  l,..,n. 

The  cutting  point  coordinates  are  expressed  in  the  workpiece  frame  as  follows: 
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To  determine  the  orientation  of  the  tool  on  the  tool  path,  using  the  frame  that  bases  on  the  geometric  shape  of  the  cutting 
tooth,  that  is  the  frame  attaching  to  the  tool  0ExEyEzE,  which  is  presented  above.  Depending  on  the  geometric  shape  of  the 
machining  part,  the  type  of  cutter  and  the  machining  conditions,  the  pose  of  the  frame  0ExEyEzE  must  be  fulfilled  for  the 
cutting  motion  on  the  workpiece.  At  a  cutting  point  on  the  tool  path,  the  orientation  parameters  of  the  tool  daE,  dpE,  dqE,  are 
determined  by  an  algorithm  that  bases  on  dxp  dyj,  dZj.  Therefore,  in  machining,  the  cutting  coordinates  of  the  tool  with 
respect  to  the  locating  frame  Odxdydzd  is  determined  by  geometric  characteristic  of  the  tool  path: 
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(13) 


The  matrix  dAE(p)  in  (4),  is  determined  at  every  point  on  the  tool  path: 
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3.2  Design  Kinematic  Trajectory 

One  of  the  important  aspects  to  satisfy  the  machining  quality  and  productivity  is  the  cutting  speed.  This  term  depends  on 
the  relative  velocity  between  the  tool  and  the  workpiece  in  a  way  such  that,  the  velocity  vector  must  be  tangential  to  the 
tool  path  at  every  cutting  point  (which  is  determined  by  the  machining  engineering  [3,4,5]). 

From  cutting  speed  function,  we  calculate  the  derivative  of  dXj,  dyr  dZj  with  respect  to  time.  This  is  carried  out  by 
analytical  method  or  numerical  method,  depending  on  the  given  tool  path  in  term  of  (11),  or  the  set  of  points.  In  general,  it 
is  expressed  as  follows: 
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%  =  %(')>  dyj  =  dyj(t).  WO 
%  =  %(*).  dyj  =  dy,(t).  WO 


(15) 

(16) 


From  (12),  (13),  (15),  (16),  obtained  the  matrix  dAE(p),  and  the  derivatives  of  its  elements.  Using  the  kinematic 
equation  (8),  we  are  able  to  compute  the  trajectories  of  the  joint  variables  with  respect  to  time;  it  means  that  we  obtained 
the  kinematic  trajectories  of  the  robot. 


4.  DYNAMIC  ANALYSIS  OF  THE  ROBOT  IN  MACHINING  PROCESS 

4.1  Dynamic  Equations 

The  dynamic  parameters  of  the  robot  are  defined  using  Autodesk  Inventor  software.  Table  3  shows  the  dynamic  parameters 
of  the  links.  The  position  of  the  center  of  gravity  with  respect  to  the  frame  i  is  Q.  m,  is  mass  of  the  link  i.  Inertial  moment 
of  the  links  with  respect  to  the  frame  attaching  at  the  center  of  mass  is  Cl©ci. 


Table  3:  Dynamic  Parameters  of  the  Robot 
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75,771 
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-1648376,169 

-18784563,41 

3 

-67,157 

33,893 

-31,362 

788,887 

45282005,604 

33499193,218 

34921423,764 

7137426,265 

-4078491,154 

1901130,489 

4 

-0,026 
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30557102,295 

9190896,176 

26143751,499 

-7417,488 

1151220,619 

-123,128 

5 
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96,297 

1187899,191 

1143345,159 

600596,740 

160,052 
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-133,866 

6 

290,94 

40,29 

-64,09 

36,306 

305737,658 

512275,019 

383507,486 

-92,536 

-36,246 

-41461,026 

The  differential  equation  of  motion  of  the  robot  in  machining  is  as  follows: 

M(q)q  +  t|/(q,  q)  +  G(q)  +  Q  =  U  (17) 


Where,  M(q)  is  the  6x6  mass  matrix  of  the  robot;  \|/(q,q)  is  the  6x1  vector  of  the  generalized  forces  of 

centrifugal  and  Coriolis  forces;  G(q,q)  is  the  6x1  vector  of  generalized  forces  of  the  consevative  forces.  U  is  the  6x1 

vector  of  generalized  forces  of  driving  torques  of  the  robot.  Q  is  the  6x1  vector  of  generalized  forces  and  torques  of  the 
cutting  forces. 


M(q)=  Z(j>1JTl+JTRlC,®c,JRi) 


an 


;  G(q,q)  =  [gl,g2,..,g6]  ,  gj  =  — 


(18) 


v(q.q)  =  [vi.V2-.V6]T.  Vj  =  X(k,1;-0<Mi’  (k-1'J)  =  - 


k,l=l 


dm 


kJ+3mij 


dim 


dqi  dqk  5qj 


(19) 


With  mi,  JTi,  JRi  is  the  mass,  the  translation  Jacobian  matrix  and  the  rotation  Jacobian  matrix  of  link  i,  respectively; 
ci0 .  is  the  inertia  tensor  of  link  i  with  respect  to  the  frame  that  is  attached  to  the  center  of  mass  Cj,  n  is  energy  of  potential 
of  the  system,  q  is  vector  of  the  joint  variables  (2),  q,q  are  the  first  and  the  second  order  derivative  of  q;  (k,  l;j)  is 
Christoffel  notation  three  indexes  of  the  first  kind;  mu  (k,l=l,..,6)  are  elements  of  the  matrix  M(q). 
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U  =  [UPU2,..,U6]T  =  [MrM2,..,M6]T 


q=[q„q2,..,q6]  =4Fc+Jtk 


;MC  =[4,4][f,mc]t  =jX 


(20) 


Where  F„  Mc  are  3x1  vectors  of  the  cutting  forces  and  torques  acting  on  the  cutter  at  the  cutting  point, 
respectively.  JTE  ,IR[  are  Jacobian  matrices  ;  rE  is  the  position  vector  with  respect  to  the  base  frame  ;  Fc  acts  on  the  point  E  ; 
CW  is  the  angular  velocity  of  the  end-effector.  J2'|i;,  are  transposed  matrices  of  JTE  JRR,  respectively. 


Fc=[Fx^y,Fz]T;Mc=[Mx,My,Mz]T;  JT 


^rE  .  r  _ 

3q’  ““  3q 


(21) 


4.2  Cutting  Forces  in  Milling  Process 

The  cutting  force  depends  on  cutting  parameters,  geometric  parameters  of  chip,  cutting  conditions,  etc.  The  cutting  force 
components  are  not  constants  because  the  material  is  not  homogeneous,  and  depth  of  cut,  feed  rate,  etc  can  be  changed  on 
the  tool  path.  The  cutting  forces  are  calculated  by  the  methods  and  formulas  presented  in  [11-15],  The  formular  of  cutting 
forces  in  x,  y,  z  directions  of  Z  cutting  -edges  are  calculated  as  (22),  where  Fx  l,  Fy  i,  FZii  are  cutting  forces  acting  on  the 
cutting  edge  i  of  the  cutter. 

F,=SFx,i>Fy=XFy,i,Fz=XFz,i  (22) 

i=l  i=l  i=l 

4.3  Computing  Inverse  Dynamic  and  Driving  Torques 

Figure  3b  repesents  the  machining  part,  which  made  of  Ti6A14V,  with  the  specific  dimensions.  The  robot  is  utilized  to 
carry  out  the  down  -  milling  operation,  by  using  the  end  ball  cutter.  Figure  3a.  Figure  3c  shows  the  the  tool  path  C.  In 
milling  process,  the  frame  x^y^zg  is  defined  so  as  xf]  is  the  tangential  line,  zf,  is  the  normal  of  the  tool  path  at  the  cutting 
point.  At  a  cutting  instant,  the  frame  xEyEzE  coincide  to  the  frame  XfjygZfj.  The  frame  xEyEzE  is  attached  to  the 
cutter’ scutting  edges,  the  parameters  6xE,  6yE,  6zE,  6aE,  6(3E,  6T|e  with  respect  to  the  frame  x6y6z6  are  determined. 


/R 


-  LI  - 

a:  The  Ball  Nose  Mill 


b:  The  Machining  Part 
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c:  The  Tool  Paths 

Figure  3:  The  Cutter  and  the  Tool  Paths. 


The  parameters  of  the  robot,  clamping  table,  the  cutter,  and  milling  process  are  given  in  table  4,  5,  6. 


Table  4:  Kinematic  Parameters  of  the  Robot 


di  (mm) 

ai  (mm) 

d2  (mm) 

a2  (mm) 

d3  (mm) 

a3  (mm) 

d4  (mm) 

d6  (mm) 

a6  (mm) 

561 

410 

215 

1075 

215 

165 

1056 

410 

-260 

Table  5:  Kinematic  Parameters  of  the  Clamping  Table 


°xd(mm) 

°yd  (mm) 

°zd  (mm) 

°ad  (rad) 

°Pd(rad) 

°r|d(rad) 

0 

-2303 

202 

0 

0 

0 

Table  6:  The  Cutter  Parameters  and  Parameters  of  Milling  Process 


Cutter’s 

Material 

D, 

(mm) 

d2 

(mm) 

Li 

(mm) 

L2 

(mm) 

z 

(rang) 

n 

(vg/ph) 

sz 

(mm/tooth) 

h0 

(mm) 

Cooling 

liquor 

Carbide 

8 

8 

63 

20 

2 

4000 

0,1 

0,2 

Emunxi 

Where  n  is  spindle  speed,  S  -  is  feed  rate,  h0  is  depth  of  cut.  Referring  to  [15],  cutting  force  coefficients  in  milling: 
Ktc  =  1844.4  (N/mm2),  Krc  =  513.2  (N/mm2),  Kac  =  1 1 18.9  (N/mm2),  Kte  =  24  (N/mm),  Kre  =  43  (N/mm),  Kae  =  -3  (N/mm). 


Figure  4:  Cutting  Forces  in  Milling. 


The  tool  path  C,  is  a  set  of  cutting  points  which  are  stored  in  a  data  file.  To  illustrate  the  above,  this  paper  presents 
calculating  the  cutting  forces,  computing  inverse  dynamics  to  determine  the  driving  torques  of  milling  process  of  the  tool 
path  C,  Figure  3.c.  The  tool  path  C  is  a  cycle,  with  radius:  r  =  40mm.  The  cutting  forces  are  computed  and  shown  in 
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Figure  4.  In  which:  the  values  of  cutting  toques  are  very  small;  the  value  of  cutting  torque  Mz  is  100  times;  Mx,  Myare 
neglected. 


0  O.S  1  1.S  2  2.5  3  3.5 

t(S) 

Figure  5:  Time  History  of  the  Joint  Positions,  Velocities  and  Accelerations. 

Figure  5  shows  time  history  of  the  joint  positions,  velocities  and  accelerations  of  the  robot.  In  which:  ql,...,q6  are 
joint  positions;  vl,...,v6  are  joint  velocities;  al,...,  a6  are  joint  accelerations.  The  results  of  solving  inverse  dynamic 
problem  is  shown  in  figure  6,  which  presents  time  history  of  driving  torques  at  the  joints  corresponding  to  the  given  cutting 
parameters  and  the  cutting  force  values. 
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t(s) 
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Figure  6:  Time  History  of  Driving  Torques  of  the  Robot  Joints. 
4.4  Computing  Direct  Dynamics 
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Figure  7:  Time  History  of  Joint  Positions  that  Obtained  by  Designed 
Trajectories  and  Integrating  the  Differential  Equations  of  Motion. 

Computation  of  direct  dynamics  plays  an  important  role.  On  one  hand,  it  can  determine  the  dynamics  status  of  the 
robot,  on  the  other  hand  it  verifies  the  reliability  of  the  driving  computation  and  control  torques  of  the  robot  in  an  inverse 
dynamics  problem.  From  the  inverse  dynamics  and  identified  driving  torques,  one  can  analyze  and  determine  the  links’ 
motion  of  the  robot.  Figure  5  shows  the  design  of  time  history  of  links’  motion.  The  control  torqueses  are  shown  in  Figure 
6.  Figure  7  presents  time  history  of  the  joint  positions,  qdl,  qd2,..,qd6  are  joint  positions  with  designed  trajectories; 
qrl,...,qr6  are  joint  positions  that  obtained  by  integrating  the  differential  equations  of  motion.  Recognizing  that  the  graphs 
exactly  match  together,  denoting  the  reliability  of  the  computed  results  of  direct  and  inverse  dynamics. 

5.  CONCLUSIONS 

The  derived  kinematic  and  dynamic  modelling  of  the  serial  robot  in  milling  process  enables  to  analyze  kinematic  and 
dynamic  problems,  effectively.  The  paper  uses  the  transformation  coordinates,  the  homogeneous  transformation  matrices, 
Lagrangian  dynamic  formulation  to  derive  the  differential  equations  of  motion.  Therefore,  the  motion  of  the  robot  system 
is  only  restricted  by  the  programme  constraints.  In  the  other  words,  the  programme  motion  guarantees  the  machining 
operation  of  the  tool  on  the  workpiece. 

Due  to  the  process  forces  existed  between  the  tool  and  the  workpiece  in  the  differential  equations  of  motion,  it  is 
hard  to  compute  the  generalized  forces  of  the  cutting  forces.  The  paper  utilizes  the  transformation  coordinates,  the 
kinematic  chains  of  the  robot  and  clamping  table  to  determine  the  fomular  of  the  generalized  forces  of  the  cutting  forces 
corresponding  to  the  generalized  coordinates.  The  illustration  is  conducted  on  a  specific  robot,  applying  in  a  specific 
milling  operation. 
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